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INCLINATION AND METHOD FOR ESTIMATION OF ROAD INCLINATION 



TECHNICAL FIELD 

The invention relates to a method for estimating the mass of a vehicle which 
10 is being driven on a road with a varying gradient according to the preamble 
to Claim 1. The invention also relates to a method for estimating the gradient 
of the road on which the vehicle is being driven according to the preamble to 
Claim 13. In particular, it relates to a method for simultaneously estimating 
the mass and the gradient of the road on which the vehicle is being driven. 



15 



BACKGROUND ART 



In order to ensure that a vehicle's movement patterns can be controlled in a 
satisfactory way. reliable Information for controlling the vehicle's 
20 transmission line and braking system must be available. It Is of the greatest 
Importance that reliable information is available regarding the vehicle's 
mass, its speed and the gradient of the road. 

A normally used method for simultaneously estimating a vehicle's mass and 
25 the gradient of the road on which the vehicle is being driven is to calculate 
the vehicle's acceleration at two adjacent moments in time, which are 
typically within an interval of 0.5 seconds. By this means gravitational forces, 
roll resistance and air resistance can be assumed to be constant. By utilizing 
Newton's second law. at said two measurement points, the vehicle's mass. 
30 which is the only unknown parameter in the equation once the acceleration 
has been calculated, is calculated from measured data concerning the speed 
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at said two measurement points. The measurement signal concerning the 
vehicle's speed is normally noisy. In order to obtain a relatively good 
estimate of the vehicle's acceleration from the noisy speed signal, it is 
important that the difference in speed should be relatively large in spite of 
5 the short interval between the measurement points. One way of obtaining 
this is to move one measurement point to a time immediately before 
changing gear and the second time to immediately after changing gear. 
However, there are a number of problems associated with this method. 
Firstly, this method requires the measurement to be carried out during 
10 difficult conditions as oscillations arise in the transmission line due to the 
flexibility of the transmission line and, where applicable, the play in the 
coupling between the tractor unit and trailer. The oscillations are stimulated 
by the driving force being discontinuous during the gear changing 
procedure. In addition, this method cannot be used if the vehicle is equipped 
15 with a gearbox of the so-called "power-shift" type where the power from the 
engine is not disconnected during a gear change. 

Another type of commonly occurring gear box is an automatically-controlled 
manual gear box. where the actual gear change procedure is controlled by 

20 an actuator after the gear position has been selected by the driver. In these 
gearboxes, the gear position is detected by a sensor after which a control 
signal to the actuator effects the gear change. With this type of gear box. it is 
possible to carry out the gear change procedure with good control. A 
problem with changing gear, particularly while travelling up an incline, is that 

25 the vehicle loses speed during the gear change procedure as there is an 
interruption in the transmitted torque. This means that it is desirable to keep 
the gear change procedure as short as possible. Manufacturers of 
gearboxes therefore try to minimise the time for the gear change procedure 
with automatically-controlled manual gearboxes, which means that the time 

30 for carrying out an estimation is reduced, whereby the accuracy of the 
measurement is reduced. 
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An example of a method which in reality requires the measurement to be 
carried out during the moment of changing gear is US 5549364. The reason 
for this is that no simultaneous estimation of the mass and the gradient of 
5 the road is carried out. This means that the estimating method is dependent 
upon two time-discrete measurement occasions. In order to manage the very 
noisy speed signal, the measurement thus needs to be carried out during the 
gear change procedure, with the abovementioned problems as a result. 

10 US 6167357 describes an example of a recursive method for estimating the 
mass of a vehicle. According to the method described, there is a 
simultaneous determination of the vehicle's mass and an air resistance 
coefficient. This coefficient is, however, not a variable, but a constant, for 
which reason the method described cannot be used for the determination of 

1 5 the gradient of the road. 

DISCLOSURE OF INVENTION 

The object of the invention is to provide a method for estimating the mass of 
20 a vehicle and/or the gradient of the road, which method does not require 
measurements to be carried out specifically during a gear change 
procedure. 

This object is achieved by a method for estimating the mass of a vehicle 
25 according to the characterizing part of Claim 1 . By using a calculating device 
within which a recursive process generates an estimate of the weight of the 
vehicle by utilizing a statistical filter utilizing input data comprising the 
vehicle's speed and a parameter which comprises a horizontal force acting 
on the vehicle, the mass of the vehicle can be determined with good 
30 convergence utilizing a statistical representation of a road with varying 
gradient. 
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This object is also achieved by a method for estimating the gradient of the 
road on which a vehicle is being driven, according to the characterizing part 
of Claim 13. By utilizing a calculating device within which a recursive 

5 process generates an estimate of the gradient of the road on which a vehicle 
is being driven by the utilization of a statistical filter utilizing said input data 
comprising the vehicle's speed and a parameter which comprises a 
horizontal force acting on the vehicle, the road's gradient can be determined 
with good convergence utilizing a statistical representation of a road with 

10 varying gradient. 

In a particularly preferred embodiment of the invention, the gradient of the 
road on which the vehicle is being driven and the mass of the vehicle are 
determined simultaneously. 

15 

In a preferred embodiment of the invention, a Kalman filter or an extended 
Kalman filter is used as statistical filter in a recursive process constituting an 
estimating method for the vehicle's mass and/or gradient of the road on 
which the vehicle is being driven. The vehicle's equation of motion 
20 constitutes in all cases the base equation for the Kalman filter. 

A Kalman filter is an estimating method for linear systems which takes 
account of the statistical behaviour of a process and measurement 
interference. In general, a Kalman filter is described by the system: 



x = Ax + Bu + v : y = Cx + Dy + w 

where x is a state vector, y is a measurement vector, u is a known system 
effect and v and w are interference vectors for process and measurement. 
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An extended Kalman Filter is an estimating method for non-linear systems. 

A fuller description of Kalman filters is given, for example, in Schmitbauer B. 
"Modellbaserade reglersystem", studentlitteratur 1999. 

5 

By means of the method according to the invention, a simultaneous 
estimation is obtained of the vehicle's mass and the gradient of the road on 
which the vehicle is being driven. 

10 In a preferred embodiment, the statistical representation of the gradient of 
the road consists of a first order process with an intensity d and a switching 
frequency coc. An estimate from a frequency range from a reference road can 
be used as the initial values of the intensity d and switching frequency Qc. 
According to an embodiment of the invention, it is however possible to 

15 update the value of the parameters d and coc by studying the variation in the 
value of the gradient of the road calculated by the process and inserting the 
most suitable value for the occasion. One way is to store the gradient 
estimate in a batch and then (perhaps every two hours) run a typical RLS 
(Recursive Least Square) algorithm in order to set the parameters, that is a 

20 first order process is adapted to a measurement series. A fuller description 
of how updating can be achieved is given in Lennart Ljung, System 
identification - theory for the user. 

According to an embodiment of the invention, the longitudinal force 
25 component is estimated from an estimate of torque delivered by an internal 
combustion engine fitted in the vehicle. The estimation is carried out in a 
way that is well known to a person skilled in the art from input data 
comprising provided fuel quantity, current engine speed and the speed of the 
vehicle. An example of how calculation of propulsion torque from vehicle 
30 data is carried out is given in US6035252. In an alternative embodiment of 
the invention, the longitudinal force component is estimated by utilization of 



wo 03/016837 



6 



PCT/SE02/01476 



an accelerometer which measures the acceleration in the longitudinal 
direction. According to a third embodiment of the invention, the longitudinal 
force component is estimated by a torque sensor located in the vehicle's 
transmission line. 

According to a preferred embodiment of the invention, the method is used for 
estimating the mass of the vehicle for dividing braking force between brakes 
in the vehicle's tractor unit and trailer. 



1 0 BRIEF DESCRIPTION OF DRAWINGS 

The invention will be described below in greater detail with reference to the 
attached drawings, in which 



15 Figure 1 



20 



25 



Figure 2 



Figure 3 



Figure 4 



shows schematically a vehicle comprising a control circuit for 
carrying out a method for estimating the vehicle's mass and/or 
the gradient of the road according to the invention. 

shows a block diagram for executing a method for estimating 
the vehicle's mass and/or the gradient of the road according to 
the invention, 

shows the result from simulations of estimations of the mass 
and the gradient of the road by the use of the estimation 
method according to the invention, and 

shows schematically a method for estimating the vehicle's 
mass and/or the gradient of the road. 



30 MODES FOR CARRYING OUT THE INVENTION 
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In a first model, the gradient of the road is estimated for a vehicle of known 
mass. The model is based on the vehicle's equation of motion in the 
vehicle's longitudinal direction. By the vehicle's longitudinal direction is 
meant the direction along the vehicle's route irrespective of at what angle in 
5 relation to the horizontal plane the vehicle is currently being driven. 

The equation of motion has the form: 



15 



20 



m V = mgsina+fp -fj. 



10 where oc is the gradient of the road, fp the propulsion force and fr the 
retardation force. The propulsion force fp comprises positive propulsion 
torque from an engine in the vehicle filtered via the vehicle's transmission. 
The retardation force fr comprises retarding forces from wheels, auxiliary 
brakes and deterministic components of roll resistance and air resistance. 



25 



Both applied propulsion force fp and retardation forces n are regarded as 
known input signals to the statistical filter. 

We have thus an input signal of the form: 

u(t)=fp(t)-fr{t) = f(t) 

After selection of the vehicle's speed v and the gradient of the road as state 
variables, the following state equations are obtained: 



= a => = a = 
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In this model, a statistical representation of a road with varying gradient is 
introduced. In an analysis, the frequency range of a reference road has been 
measured. Study of the frequency range shows that the frequency range can 
be approximated with relatively good accuracy by a first order process. Of 
5 course, other processes of higher order can be used, with the result that the 
dimensions of the state equations increase. The studied reference road 
segment shows a switching frequency of fc = 0.002 cycles/m and a noise 
intensity of 0.8 (radians)^/(cycles/m) 

10 The statistical representation is used in the above state equation, whereby 
the following state equation is obtained: 



X, =V=>X, =gXj + 



m 



2 J 







"0 


g ' 








A = 




V = 








0 






3. 



A further possibility for improving the estimate of the gradient of the road is 
15 obtained by an improved model of the interference forces, where the 
interference forces are modelled by a first order process instead of being 
modelled by white noise. 

This is possible, as the magnitude of the error in the propulsion and braking 
20 torque from the engine and auxiliary brakes, roll resistance and air 
resistance is known, but not its frequency content. The state equation is 
therefore extended by an additional state xa = fdist and thereafter has the 
following appearance: 



25 
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3. 



where Od is the switching frequency of the interference force and d is the 
intensity of the noise. 

5 In order to make possible simultaneous estimation of the mass of the vehicle 
and the gradient of the road on which the vehicle is being driven, the state 
equation must be extended by at least one additional state corresponding to 
the mass of the vehicle. According to this embodiment of the invention, the 
mass of the vehicle and the gradient of the road on which the vehicle is 
10 being driven are estimated by using an estimation of a variable which 
comprises longitudinal force components which in this case correspond to 
applied propulsion force fp and retardation forces fr together with a statistical 
representation of a road with varying gradient. The propulsion force is 
estimated according to an embodiment of the invention by Input data 
1 5 concerning the speed of the vehicle, amount of fuel supplied to the vehicle's 
cylinders and current engine speed of the internal combustion engine being 
transformed into a value for propulsion torque of the internal combustion 
engine. This transformation between input data and propulsion torque is 
carried out in a processor in the vehicle in a way that is well known to a 
20 person skilled in the art by the utilization of calculations and mappings of 
input data into propulsion torque based on experience. According to an 
alternative embodiment of the invention, the propulsion torque is estimated 
by an output signal from a torque sensor placed in the vehicle's transmission 
line. The estimated torque is thereafter transformed by filter to a propulsion 
25 force via information concerning current gearing between the drive shaft 
from the internal combustion engine and the driving wheels. 
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Together with the utilization of a first order model of the variation in the 
gradient of the road, according to what was described above, we obtain the 
following state equation: 



20 



X3 



m = X3 = Uj 



The equation is a non-linear state equation, for which reason an extended 
Kalman filter must be used. The state equation is of the form 



10 X = f(x,t) + V 
y = g (x,t) + w 

where f(x.t) is non-linear and g{x,t) is linear. By the use of an extended 
1 5 Kalman filter, the model is linearised around the estimate of the state vector 
X. Difference equations are preferably used instead of differential equations 
in real-time applicatio'ns. Together with a Euler approximation of the time 
derivative, x = (x(t+h) - x(t))/h. this gives a discrete state equation as follows: 

X^{t + 1) = (1 - /l<»c>2 + = + K 

xAt + 1) = (1 - + /n'4 = /. + 'n'n 



The next step is to linearise the above state equation around the estimate of 
the state vector x. whereby the following linear state equation is obtained: 
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Simultaneous estimation of the mass m of the vehicle and the gradient a of 
the road on which the vehicle is being driven is now possible by using the 

5 above state equation recursively utilizing the vehicle's speed v and 
information about applied propulsion force fp and retardation forces fr. The 
propulsion force fp consists of positive propulsion torque from an engine in 
the vehicle filtered via the vehicle's transmission. The retardation forces f, 
comprise retarding forces from wheels, auxiliary brakes and deterministic 

10 components of roll resistance and air resistance. In order to obtain a stable 
approximation of the state vector, in a preferred embodiment the process is 
stopped when the driver applies the service brake as the friction between the 
brake lining and the brake disc normally has great stochastic variation. 

1 5 According to a second embodiment of the invention, the mass of the vehicle 
and the gradient of the road on which the vehicle is being driven are 
estimated by using an estimation of a variable which comprises a 
longitudinal force component which in this case corresponds to an input 
signal from an accelerometer that measures specific force along the 

20 vehicle's longitudinal extent together with a statistical representation of a 
road with varying gradient. 

In this case, a state variable X3 is introduced, which corresponds to the 
longitudinal acceleration in the state equation. The longitudinal acceleration 
25 is modelled with a first order process with a switching frequency We 
obtain a state equation as follows: 
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5 By using the input signal a(t) from an accelerometer. the estimation of the 
gradient of the road on which the vehicle is being driven can be carried out 
without direct connection to the mass of the vehicle. The vehicle's mass can 
therefore be estimated simultaneously by utilizing the control force f(t) 
according to the above, by the relationship a(t) = -f(t)/m. This means that 

1 0 when the input signal from an accelerometer is used, the estimation problem 
can be divided between two separate filters, a kinematic filter without 
equation of motion for estimating the gradient of the road and a dynamic 
filter concerning the mass. 

15 The dynamic filter's appearance for determining the mass is apparent from 
the following state equation: 

'''"'",?'^7? X \^A = 0 Bu^[0]C = [{a{t)-x,)]o^[u,] 
y = f{th{a{t)-x,)x,+wl 



20 



Figure 1 shows schematically a control system for a vehicle where the 
method described above can be applied for estimating the gradient of the 
road on which the vehicle is being driven, the mass of the vehicle, or 
alternatively simultaneous estimation of the gradient of the road on which the 
25 vehicle is being driven and the mass of the vehicle. 

The control system is of the type that is described in patent specification US 
6167357 to which reference should be made for a more detailed description. 

30 The vehicle 10 comprises an internal combustion engine 11 and a gearbox 
12 which connects the internal combustion engine 11 to a drive shaft 13 for 
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a set of wheels 14 via an outgoing shaft 15. The internal combustion engine 
1 1 is controlled by an engine control unit 16 which uses an input signal from 
an accelerator pedal 17 and where applicable a constant speed regulator 
18 The internal combustion engine 11 and its engine control unit 16 are of 
5 conventional type where the engine control unit controls the fuel injection, 
engine brake, etc. according to input signals from the accelerator pedal 17. 
speed sensor 19 and brake control system 20. 

The gearbox 12 is controlled according to the embodiment shown by a 
1 0 gearbox control unit 21 which controls the gear shift by the input signal from 
the speed sensor 19 or alternatively from the Input signal from a gear 
selector 22 on the vehicle. The invention can also be used on vehicles 
without electronically-controlled gearboxes. In an embodiment of the 
invention, it is, however, necessary to record which gear is currently being 
15 used by the vehicle. The gearbox and its control unit are of conventional 
type. 

The brake control system 20 is controlled by input signals from a service 
brake control 23 and. where applicable, an auxiliary brake control 24. The 

20 apportionment between service brake and auxiliary brake can. where 
applicable, be carried out automatically. The brake control system generates 
output signals to the engine control system 16 for controlling the injection 
and the engine brake, to other auxiliary brakes, where applicable, for 
example in the form of a retarder 25 which is controlled by a control device 

25 26. and to the sen/ice brakes 27. Where applicable, there is a apportionment 
of the braking force between the vehicle's pairs of wheels and. where 
applicable, service brakes 33 on pairs of wheels 28. 29 on a trailer unit 30 
connected to the framework structure 31 of the vehicle 10 via a coupling 32. 

30 The vehicle also comprises a calculating device 34 for estimating the mass 
of a vehicle, for estimating the gradient of the road on which the vehicle .s 
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being driven, or alternatively for simultaneously estimating the mass of a 
vehicle and estimating the gradient of the road on v^hich the vehicle is being 
driven. 

5 The calculating device 34 receives input data from the speed sensor 19. 
According to an embodiment of the invention, the calculating device receives 
in addition information from an accelerometer 35 which measures the 
vehicle's acceleration in the longitudinal direction and uses this information 
to determine a variable which comprises a longitudinal force acting on the 
10 vehicle. According to an alternative embodiment, a variable is measured 
which comprises a longitudinal force acting on the vehicle by recording 
applied propulsion force fp and retardation forces f. For this purpose, the 
calculating device uses input signals from the brake control system 20 for 
determining the size of the applied braking forces, in particular the size of 
15 forces applied via the auxiliary brakes. In addition, input signals are used 
from the speed sensor 19 to determine the roll resistance and air resistance. 
In an embodiment of the invention, information from the engine control 
system 16 is used for determining torque delivered by the internal 
combustion engine. In another embodiment of the invention, the input signal 
20 from a torque sensor 36 placed along the vehicle's transmission line is used. 
In addition, the input signal from the gearbox control unit 21 is used to 
determine the applied propulsion force from the calculated or measured 
propulsion torque. 

25 All the input signals to the calculating device 34 are of conventional type and 
are available via the communication system that is used in the vehicle, 
normally a data bus. 

The calculating device 34 generates output signals corresponding to the 
30 gradient of the road on which the vehicle is being driven 38 and/or the 
vehicle's mass 37. depending upon which of the processes described above 
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for determining the state equations determining the vehicle's movement has 
been selected. The calculating device 34 comprises memory areas and 
processors whereby iteration of the recursive process can be carried out 
with generation of an estimate of the gradient and/or the mass as a result. 



5 



Figure 2 shows a block diagram for a process for executing a method for 
estimating the vehicle's mass according to the invention. 

10 The figure describes the principal flow for simultaneous estimation of mass 
and gradient (without specific force measurement). The 
estimation/measurement of the tractive force and auxiliary braking force are 
not dealt with in detail. Nor is the signal processing (filtering, etc) of other 
measured signals dealt with in detail. 

15 

The following designations are used for quantities in the estimation process. 
Area: The wind resistance area of the vehicle 
Cd: Wind resistance coefficient 
Cr: Roll resistance coefficient 
20 g: .Gravitation constant 

hi; Updating time for fjhreshold 

ha: Updating of the gradient process parameters, relatively long time (hours) 
h: Sampling time 

d: The intensity of the gradient process 
25 e: The intensity of the force interference process 

In a first function block 40, the applied propulsion torque is estimated and 
also the calculated propulsion force from the estimate of the propulsion 
torque. In addition, the applied braking torque and braking force from 
30 auxiliary brakes are estimated. Input data to the first function block 40 
consists of a set of variables including accelerator pedal position, engine 
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speed, injected fuel quantity, gear position, turbo pressure where applicable, 
drive shaft speed and a state variable for auxiliary brakes which can include 
the air pressure In the auxiliary brakes and/or power supply to electrical 
retarders. The estimation of propulsion force and braking force from auxiliary 

6 brakes from said Input data Is carried out by conventional techniques well 
known to a person skilled in the art and will therefore not be explained in 
greater detail. The estimation of propulsion force from said given input data 
is described, for example, in Anderson B.D.O.. More J.B., Optimal Filtering. 
Information and System Science Series. Prentice-Hall, University of 

10 Newcastle, New South Wales, Australia, 1979. 

Output signals from the first function block constitute a first state variable 
s(1) corresponding to the propulsion force and a second state variable s(4) 
corresponding to the braking force from the auxiliary brakes. 



15 



These two state variables s(1 ) and s(4) form input data for a second function 
block 50 together with a third state variable s(3) con-esponding to a binary 
value determining whether the service brakes are used or not, and a fourth 
state variable s(2) corresponding to the speed of the vehicle. In the second 
20 function block, the force in the vehicle's longitudinal direction is calculated. 
In a first embodiment of the invention, the force is calculated according to 
the following relationship: 

f(t) = s(1) - 0.5Cd-Area s2(s) - Cr*g*s(9) - s(4) where s(9) is a ninth state 
25 variable corresponding to an estimated value of the vehicle's mass. The 
force f(t) constitutes a fifth state variable s(5). In addition, a sixth state 
variable s(6) is created that constitutes the variance of the force f(t) and is 
used as a threshold value for estimation to be able to take place. 
We have thus: f_threshold(t) = variance(f(t). s(5) = f(t) and s(6) = 
30 f_threshold(t). 
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In order to obtain a good estimation, it is necessary for the dynamic system 
to be stimulated sufficiently. 

In an alternative embodiment of the invention, the calculation of the force 
6 from output signals from the first function block 40 is replaced by a 
calculation from an input signal from a third function block 60 where input 
signals from torque sensors are used Instead of estimates based on other 
parameters. 

10 Input signals to a fourth function block 70 consist of the output signals 
created in the second function block 50 and a seventh state variable s(7) 
corresponding to the estimated state vector Xest, an eighth state variable 
s(8) corresponding to the covariance matrix P(t) of the estimation error and, 
where applicable, updated values of the switching frequency Oc and the 

15 interference intensity d. The state vector Xest comprises the states: speed, 
s(2), the gradient of the road s(10), the mass s(9) and the interference force. 
These states are given In the equation on top of page 10. In the fourth 
function block, a control is carried out in a first process step of whether the 
system is sufficiently stimulated for estimation to be allowed to take place. 

20 This is carried out by Investigating whether the sixth state variable exceeds a 
particular limit value and whether the third state variable Is equal to zero, 
which means that the service brakes are not being used. The condition has 
thus the following appearance: If s(3) = 0 and s(6)>Threshold 

25 If these conditions are fulfilled, the system matrix A(t) is defined in a second 
process step, which system matrix is a function of s(5), s(2), h, g, Wc and Wd, 
and the process interference matrix Ri(t) is defined, which process 
interference matrix is a function of s(2), d, and e. The system matrix Is given 
by the equation given at the top of page 1 1 . The appearance of the functions 

30 is given under the above description of Kalman filtering. In addition, a 
measurement matrix C(t) and measurement interference matrix R2(t) are 
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created, the appearance of which is also shown under the above description 
of Kalman filtering. 

Thereafter in the third process step, the Ricatti equation, the Kalman filter, 
6 are calculated and the state vector is updated. During this process step, the 
estimate of the state vector Xest(t) forms a seventh state variable s(7) and 
the covarlance matrix P(t) of the estimation error forms an eighth state 
variable s(8). 

10 The optimal weighting matrix K(t+1 ) is calculated from the relationship: 
K(t+1) = A(t)P(t)C''(t)inv(C(t)P(t)C''(t) + RaCt)) 

The covarlance matrix P(t) of the estimation error is calculated from the 
16 relationship: 

P(t+1 ) = A(t)P(t)*AT(t) - A(t)P(t)*C^(t)inv(C(t)P(t)*C''(t) + R2{t)) C(t)*P(t)*A^(t) + 
Ri(t) 

20 The estimate of the state vector Xest(t) is updated as follows: 
Xest(t+1) = f(Xest(t),t) - K(t+1)(y(t) - C(t)Xest(t)) 

If the condition for estimation was not fulfilled In the first process step, the 
25 covarlance matrix and the state vector are replaced in a fourth step as 
follows: 

P(t+1) = P(t); 
Xest(t+1) = Xest(t> 

30 
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For a fuller description of how the Ricatti equation and the Kalman filter are 
calculated, refer to Schmidtbauer B. "Modellbaserade reglersystem", 
studentlitteratur 1999. 

5 Output signals from the fourth function block 70 constitute the seventh state 
variable s(7) and the eighth state variable s(8). Where applicable, the state 
s(9) corresponding to an estimated value of the mass is selected from the 
seventh state variable s(7) in a fifth function block 80. Where applicable, a 
state s(10) corresponding to an estimated value of the gradient of the road 

10 on which the vehicle is being driven is selected in a sixth function block 90. 

According to an embodiment of the invention, new estimated values of 
switching frequency and interference intensity of the variation of the gradient 
of the road are created in a seventh function block 100. These new values 
1 5 are input back to the fourth function block. 

Figure 3 shows the result from running a simulation model utilizing the 
estimating method described above. Broken lines represent actual 
20 parameter values and solid lines represent estimated values. In the shaded 
areas the system was stimulated too weakly, for which reason an error in the 
mass estimate would occur if no threshold requirement had been laid down. 
Note that the gradient of the road can be estimated even though the 
estimation of the mass is not running. 

25 

Figure 4 shows schematically a method for estimating the mass of a vehicle 
according to the invention. 

30 In a first method step 110, a measurement is carried out of the vehicle's 
speed for generating input data for a calculating device. The speed is 
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measured in some way well known to a person skilled in the art. for example 
by a speedometer 19 (Figure 1). The speed constitutes input data for a 
calculating device 34 (Figure 1). 

5 In a second method step 120, a measurement is carried out of a variable 
which comprises a longitudinal force acting on the vehicle for generating 
input data for a calculating device. 

This measurement can be carried out according to a first embodiment via an 
10 accelerometer 35 (Figure 1) which measures the vehicle's acceleration in a 
longitudinal direction and uses this information to determine a variable which 
comprises a longitudinal force acting on the vehicle. 

According to an alternative embodiment, a variable is measured which 
15 comprises a longitudinal force acting on the vehicle by recording applied 
propulsion force fp and retardation forces f. For this purpose, the calculating 
device uses input signals from the brake control system 20 (Figure 1) to 
determine the size of the applied braking forces, in particular the size of the 
force applied via the auxiliary brakes. In addition, the input signal from the 
20 speed sensor 19 (Figure 1) is used to determine roll resistance and air 
resistance. In an embodiment of the invention, infomiation is used from the 
engine control system 16 (Figure 1) to determine torque delivered by the 
internal combustion engine. In another embodiment of the invention, the 
input signal is used from a torque sensor 36 (Figure 1) placed along the 
25 vehicle's transmission line. In addition, the input signal from the gearbox 
control unit 21 (Figure 1) is used for determining applied propulsion force 
from the calculated or measured propulsion torque. 

Common to both embodiments is that the longitudinal force acting on the 
30 vehicle is determined. 
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According to a first embodiment of the invention, in a third method step 130 
the calculating device 34 (Figure 1) generates an estimate of the weight of 
the vehicle by a recursive process by using a statistical filter using said input 
data comprising the speed of the vehicle and said variable which comprises 
5 a longitudinal force acting on the vehicle and a statistical representation of a 
road with varying gradient. 



The recursive process preferably consists of the recursive process that is 
described in association with Figure 2. The recursive process consists 
10 preferably of a Kalman filter 70 (Figure 2). The process uses the state 
variables: speed, gradient of the road, mass and interference force, 
according to the equations that are listed on top of page 10. According to an 
embodiment, the system matrix of the Kalman filter has the appearance that 
is defined at the bottom of page 1 0. 

15 

The statistical representation of a road with varying gradient is included in 
the system matrix. In an analysis, the frequency range of a reference road 
has been measured. Study of the frequency range shows that the frequency 
range can be approximated with relatively good accuracy by a first order 
20 process. Of course, other processes of higher order can be used, with the 
result that the dimensions of the state equations increase. 



As the mass of the vehicle constitutes a state which is included in the 
recursive process, according to the first embodiment of the invention, the 

25 recursive process generates updated approximations of the mass. 

According to a second embodiment of the invention, the recursive process 
generates updated approximations of the gradient of the road. This is carried 
out according to the second embodiment in a third method step 130', which 
is identical to the third method step in the first embodiment, except that the 

30 state corresponding to the gradient of the road constitutes the state which is 
of interest. As the gradient of the road constitutes a state which is included 
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in the recursive process, according to tlie second embodiment of tlie 
invention, tine recursive process generates updated approximations of the 
gradient of the road. 

5 According to a third embodiment of the invention, the recursive process 
generates updated approximations of the gradient of the road and the mass 
of the vehicle. This is carried out according to the third embodiment in a third 
method step 130" which is identical to the third method step in the first or 
second embodiment, except that the states corresponding to the gradient of 

10 the road and the mass of the vehicle constitute the states that are of interest. 
As the gradient of the road and the mass of the vehicle constitute states 
which are included in the recursive process, according to the third 
embodiment of the invention, the recursive process generates updated 
approximations of the gradient of the road and the mass. 

15 

The Invention is not to be limited to the embodiments described above, but 
can be varied freely within the framework of the following patent claims, for 
example the invention can also be used in vehicles that are propelled by 
engines other than internal combustion engines, for example electric motors. 

20 
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CLAIMS 



1 ) Method for estimating the mass of a vehicle which is being driven on 
a road with varying gradient, comprising the following method steps: 

6 - measurement of the vehicle's speed for generating input data for a 

calculation device; 

- measurement of a variable which comprises a longitudinal force 
acting on the vehicle for generating input data for a calculation 
device; 

1 0 characterized in that 

said calculation device generates an estimate of the weight of the 
vehicle by means of a recursive process by using a statistical filter 
using said input data comprising the speed of the vehicle and said 
variable and a statistical representation of a road with varying 

1 5 gradient. 

2) Method according to Claim 1, characterized in that said recursive 
process generates simultaneous estimates of the mass of the vehicle 
and the gradient of the road on which the vehicle is being driven. 

20 

3) Method according to Claim 1 or 2, characterized in that said statistical 
filter consists of a Kalman filter or alternatively an extended Kalman 
filter representing the equation of motion of the vehicle. 

25 4) Method according to Claim 3, characterized in that the vehicle's 
speed and the gradient of the road are selected as state variables in 
said Kalman filter. 



5) 

30 



Method according to any one of the preceding claims, characterized 
in that said statistical representation of the gradient of the road 
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consists of a first order process with an intensity d and a switciiing 
frequency ©c. 

6) Method according to Claim 5, characterized in that the size of said 
5 intensity d and the switching frequency are updated on the basis of 

information concerning the gradient of the road generated from said 
recursive process. 

7) Method according to any one of the preceding claims, characterized 
10 in that said parameter comprising a longitudinal force component is 

calculated from an estimate of torque delivered from an engine in said 
vehicle. 

8) Method according to Claim 7, where said engine consists of an 
15 internal combustion engine, characterized In that said delivered 

torque is estimated on the basis of information concerning the amount 
of fuel supplied to the combustion chamber of the internal combustion 
engine and the operating speed of the internal combustion engine. 

20 9) Method according to Claim 7, characterized in that said delivered 
torque is estimated from a torque sensor placed in association with 
the vehicle's transmission line. 

Method according to Claim 7, 8 or 9, characterized in that said 
horizontal force component is calculated from said delivered torque 
and information concerning the current gearing between the drive 
shaft from the internal combustion engine and the vehicle's current 
driving wheels. 

30 11) Method according to any one of Claims 1-6, characterized in that 
said parameter comprising a horizontal force component is estimated 



10) 

25 



wo 03/016837 



25 



PCT/SE02/01476 



using an accelerometer which measures the acceleration in the 
longitudinal direction of the vehicle. 

12) Method according to any one of the preceding claims, characterized 
5 in that information regarding the mass of the vehicle is used for the 

apportionment of braking force between brakes in the vehicle's tractor 
unit and trailer. 



13) Method for estimating the gradient of a road on which a vehicle is 
10 being driven, comprising the following method steps: 

- measurement of the vehicle's speed for generating input data for a 
calculation device; 

- measurement of a variable which comprises a longitudinal force 
acting on the vehicle for generating input data for a calculation 

1 5 device; 

characterized in that 

said calculation device generates by means of a recursive process an 
estimate of the gradient of the road on which the vehicle is being 
driven, by using a statistical filter using said input data comprising the 
20 vehicle's speed and said variable and a statistical representation of a 

road with varying gradient. 

14) Method according to Claim 13, characterized in that said statistical 
filter consists of a Kalman filter or alternatively an extended Kalman 

25 filter representing the equation of motion of the vehicle. 

15) Method according to Claim 14, characterized in that the vehicle's 
speed and the gradient of the road are selected as state variables in 
said Kalman filter. 



30 
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16) Method according to any one of Claims 13-15, characterized in that 
said statistical representation of the gradient of the road consists of a 
first order process with an intensity d and a switching frequency ©c. 

5 17) Method according to Claim 16, characterized in that the size of said 
intensity d and the switching frequency ©c are updated on the basis of 
information concerning the gradient of the road generated from said 
recursive process. 

10 18) Method according to any one of Claims 13-17, characterized in that 
said parameter comprising a longitudinal force component is 
calculated from an estimate of torque delivered from an engine in said 
vehicle. 



15 19) Method according to Claim 18. where said engine consists of an 
internal combustion engine, characterized in that said delivered 
torque is estimated on the basis of information concerning the amount 
of fuel supplied to the combustion chamber of the internal combustion 
engine and the operating speed of the internal combustion engine. 

20 

20) Method according to Claim 18, characterized in that said delivered 
torque is estimated from a torque sensor placed in association with 
the vehicle's transmission line. 

26 21) Method according to Claim 18. 19 or 20, characterized in that said 
horizontal force component is calculated from said delivered torque 
and information concerning the current gearing between the drive 
shaft from the internal combustion engine and the vehicle's current 
driving wheels. 



30 
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22) Method according to any one of Claims 13-17, characterized in that 
said parameter comprising a horizontal force component is estimated 
using an accelerometer which measures the acceleration in the 
longitudinal direction of the vehicle. 

5 

23) Method according to any one of Claims 13-22, characterized in that 
information regarding the mass of the vehicle is used for the 
apportionment of braking force between brakes in the vehicle's tractor 
unit and trailer. 
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